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^ ' Abstract 

in 

a^ 

^D ' We investigate local configuration controllability for mechanical control systems 

(^ ' within the affine connection formalism. Extending the work by Lewis for the single- 

^? ' input case, we are able to characterize local configuration controllability for systems 



with n degrees of freedom and n — 1 input forces. 



1 Introduction 



Mechanical control systems belong to a class of nonlinear systems whose controllability 
properties have not been fully characterized yet. Much work has been devoted to the study of 
their rich geometrical structure, both in the Hamiltonian framework (see [|1^ and references 



therein) and in the Lagrangian one, which is receiving increasing attention in the last years 
1^, |l^, 0, |13], |15|, |16|, [18|. This research is providing new insights and a bigger understanding 
of the accessibility and controllability aspects associated to them. In this direction, the affine 
connection formalism has revealed to be very useful modelling different types of mechanical 
systems, such as natural ones (Lagrangian equal to kinetic energy minus potential energy) 



15| , p!q] , with symmetries 0, with nonholonomic constraints |T3[,... and, on the other hand. 



it has led to the development of some new techniques and control algorithms for approximate 



trajectory generation in controller design [^, ^. Certainly, we shall see further progress in 
these directions in future years. 

From a theoretical point of view, underactuated mechanical control systems offer a control 
challenge as they have non-zero drift, their linearisation at zero velocity is not controllable 
and they are not feedback linearisable as well. That is, they are not amenable to standard 
techniques in control theory |T^. The work by Lewis and Murray [|T5], [1^ on simple me- 



chanical control systems has rendered strong conditions for configuration accessibility and 
sufficient conditions for configuration controllability. The conditions for the latter one are 
based on the sufficient conditions that Sussmann obtained for general affine control sys- 



tems |21]. It is worthy to note the fact that these conditions are not invariant under input 



transformations, as the simple example of the planar rigid body shows |jT5| 



As the controllability is the more interesting property in practice, more research is needed 
in order to sharpen the configuration controllability conditions. Lewis |T2| started this pro- 
cess by investigating and fully solving the single-input case, building on previous results by 
Sussmann for general scalar- input systems [Q. The recent work by Bullo [0, |^ on series 
expansion for the evolution of a mechanical control system has given the necessary tools to 
tackle this problem in the much more involved multi-input case, as well as a powerful ma- 
chinery for the design of motion control algorithms for a large class of autonomous vehicles, 
robotic manipulators and locomotion devices. In this paper, we characterize local configu- 
ration controllability when the number of inputs and the degrees of freedom differs by one. 
Both results, Lewis' and ours, can be seen as particular cases of the following conjecture, 
which remains open: The system is local configuration controllable at a point if and only if 
there exists a basis of inputs satisfying the sufficient conditions for local configuration con- 
trollability at that point. The conjecture relies on the fact we have mentioned before: the 
lack of invariance of the sufficient conditions under input transformations. It is remarkable 
to note that local controllability has not been characterized yet for general control systems, 
even for the single input case (in this respect see [|, ^, [21[|). 



The paper is organised as follows. In Section 2, we describe the affine connection framework 
for mechanical control systems and recall the controllability notions we shall consider on 
them. In Section 3 we review the existing results concerning configuration controllability 
|T^, |TB] and the series expansion for the evolution of a mechanical control system developed 
by Bullo in [g, |^. In Section 4 we briefiy recall the single-input case solved by Lewis 
and properly state his conjecture. Section 5 contains the main contributions of this paper. 
Finally, in Section 6 we expose a simple example on a 4-dimensional manifold with 2 inputs 
whose we can not decide if it is configuration controllable or not. It certainly does not admit 
a new input basis verifying the sufficient conditions, so that if controllable, it would be a 
counter example of the above stated conjecture. 



2 Simple Mechanical Control Systems 

Let Q be a n-dimensional manifold. We will denote by TQ the tangent bundle of Q, by 
X((5) the set of vector fields on Q and by C°°(Q) the set of smooth functions on Q. 

A simple mechanical control system is defined by a triple (Q, g-, J^), where Q is the man- 
ifold of configurations of the system, g is a Riemannian metric on Q and JF = {F^, . . . , F™} 
is a set of m linearly independent 1-forms on Q, which physically correspond to forces or 
torques. 

Associated with the Riemannian metric g there is a natural afiine connection, called the 
Levi-Civita connection. An afHne connection [I|, |Tl| is defined as an assignment 



V : X(Q) X XiQ) -^ x(g) 
(X,F) ^ VxY 

which is M-bilinear and satisfies V jxY = fVxY and VxifY) = fVxY + X{f)Y, for any 
X,Y e X(Q), / e C°°(g). A curve c : [a,b] — > Q is a geodesic for V if Vc{t)c{t) = 0. 
Locally, the condition for a curve t -^ {x^{t), . . . , x^{t)) to be a geodesic can be expressed as 

x" + Tlx^x" = , 1 < a < n , (1) 

where the T'^^{x) are the Christoffel symbols of the afiine connection, that is, they are given 

d d 

by V_s_— — ^ = Tfec^"^- The geodesic equation (|1|) is a first-order differential equation on 

dx^ OX OX 

TQ. The vector field corresponding to this first-order equation is given in coordinates by 



bc'^ 



dx" "" dv" 

and is called the geodesic spray associated with the afiine connection V. Hence, the 
integral curves of the geodesic spray S, (a;",i;") are the solutions of the geodesic equation. 

The Levi-Civita connection V^ is determined by the formula 

giV'xY,Z) = ^iXigiY,Z)) + YigiZ,X))-ZigiX,Y)) 

+giY, [Z,X])-g{X, [Y,Z])+g{Z, [X,Y])) , X,Y,Ze X(Q) . 



Instead of the input forces F^, . . . , F"^, we shall make use of the vector fields Yi, . . . ,Ym, 
defined as Yi = tic,(-F*), where jjg = b^^ and \)g : TQ — > T*Q is the musical isomorphism given 
by \)g{X)(Y) = g{X,Y). Roughly speaking, this corresponds to consider "accelerations" 
rather than forces. 



The control equations for the simple mechanical control system may then be written as 

'^iit)m = j:^'{m{c{t)). (2) 

The inputs we consider come from the set 

W = {n : [0, T] ^ M^l T > 0, u is measurable and ||m|| < 1} . 

We can use a general affine connection in (Q) instead of the Levi-Civita connection without 
changing the structure of the equation. This is particularly interesting, since nonholonomic 
mechanical control systems give also rise to equations of the form (|^) as explained in |TB[ . 



We can turn (0) into a general affine control system with drift 

x{t) = f{x{t)) + Y^u\t)gMt))- (3) 

To do this we need another bit of notation. The vertical lift of a vector field X on Q is the 
vector field X^ on TQ defined as 

d 



^>- - dt 



{v, + tX{q)) 



d d 

In coordinates, if X = X"'— — , one can check that X^ = X°'— — . Then, the second-order 

oq"- ov"- 

equation (|^) on Q can be written as the first-order system on TQ 

V = S{v) +Y.u\t)Y^\v) , (4) 

where S is the geodesic spray associated with the affine connection V^. 

2.1 Controllability Notions 

The control equations for the mechanical system (H) are nonlinear. No standard technique in 



control theory [0, as for example the linearisation around an equilibrium point or lineari- 



sation by feedback, yields satisfactory results in the analysis of its controllability properties. 

The point in the approach of Lewis and Murray to simple mechanical control systems is 
precisely to know what is happening to configurations, rather than to states, since in many 
of these systems, configurations may be controlled, but not configurations and velocities at 
the same time. The basic question they pose is "what is the set of configurations which are 
attainable from a given configuration starting from rest?" Moreover, since we are dealing 
with objects defined on the configuration manifold Q, we expect to find answers on Q, 
although the control system (HI) lives in TQ. 



Definition 2.1 A solution of ^ is a pair {c,u), where c : [0,T] — > Q is a piecewise 
smooth curve and u eU such that {c,u) satisfies the first order control system (0j. 

Consider go ^ Q, {Qo, O^q) G Tg^^Q and let U C Q, tj C TQ be neighbourhoods of go and 
(go, Ogo), respectively. Define 

7^Q(go,T) = {q E Q \ there exists a solution {c,u) of (Q) such that 

c(0) = Ogo, c(t) G f/for t e [0, T] and c{T) G T^g} 
TZ^Q{qo,T) = {(g, f) G TQ | there exists a solution (c, m) of (Q) such that 

c(0) = Ogo, (c(t),c(t)) G ?7for t G [0,T] and c(T) = i; G TgQ} 

and denote by 7^g(go, < T) = Uo<t<T^Q(go, t), T^TQilo, <T) = Uo<t<r^TQ(?o, i!:)- 
Now, we recall the notions of accessibility considered in [^ . 



Definition 2.2 T/ie system (j^ zs locally configuration accessible (LCA) at go G Q 
if there exists T > such that 7?.Q(go,< t) contains a non-empty open set of Q, for all 
neighbourhoods U of go and all < t < T . If this holds for any go G Q then the system is 
called locally configuration accessible. 

Definition 2.3 The system (^ is locally accessible (LA) at go G Q and zero velocity 

if there exists T > such that T^TQilOj — ^) contains a non-empty open set ofTQ, for all 
neighbourhoods U of (go, Og(,) and all < t < T . If this holds for any go G Q then the system 
is called locally accessible at zero velocity. 



We shall focus our attention on the following concepts of controllability []T5 

Definition 2.4 The system (^ is small-time locally configuration controllable (STLCC) 
at go G Q if there exists T > such that 7^Q(go, < t) contains a non-empty open set of Q 
to which go belongs, for all neighbourhoods U of Qq and all < t < T. If this holds for any 
go G Q then the system is called small-time locally configuration controllable. 

Definition 2.5 The system (^ is small-time locally controllable (STLC) at go G Q 
and zero velocity if there exists T > such that IZ^gigo, ^ t) contains a non-empty open 
set ofTQ to which (go, Og,,) belongs, for all neighbourhoods U of (go, Og,,) and all < t < T . 
If this holds for any go G Q then the system is called small-time locally controllable at zero 
velocity. 



3 Existing Results 



Here we review some accessibility and controllability results obtained in [|T^, |T^ and expose 
the work by Bullo |^, ^ in describing the evolution of mechanical control systems via a series 
expansion. This series will be key in the proof of the main results of this paper. 



3.1 On Controllability 

The symmetric product on X{Q) is defined by 

{X:Y) = VxY + VyX . 

The geometric meaning of the symmetric product is the following [|14|: a geodesically 
invariant distribution D is a distribution such that for every geodesic c(t) of V starting 
from a point in V, c(0) G ^c(o)) we have that c{t) G T>c(t)- Then, one can prove that V is 
geodesically invariant if and only if {X : Y) ^ V, VX, Y ^T>. 



Given the input vector fields 3^ = {Yi, . . . , Ym}, let us denote by Sym{y) the distribution 
obtained by closing the set 3^ under the symmetric product and by Lie{y) the involutive 
closure of 3^. With these ingredients, one can prove 



Theorem 3.1 ([T3^J) The control system (^ is locally configuration accessible at q (respec- 
tively locally accessible at q and zero velocity) if Lie{Sym{y))g = TgQ (respec. Sym{y)q = 
T,Q). 

If P is a symmetric product of vector fields in y, we let 7j(-P) denote the number of occur- 
rences of Yi in P. The degree of P will be 7i(-P) + . . . + '~frn{P)- We shall say that P is bad 
if 'jiiP) is even for each 1 < i < m. We say that P is good if it is not bad. The following 
theorem gives sufficient conditions for STLCC. 

Theorem 3.2 Suppose that the system is LCA at q (respectively, LA at q and zero velocity) 
and that y is such that every bad symmetric product P at q in y can be written as a linear 
combination of good symmetric products at q of lower degree than P. Then (^ is STLCC 
at q (respec. STLC at q and zero velocity). 



This theorem was proved in |T^ , adapting previous work by Sussmann [^ on general control 
systems of the form (H) . 
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3.2 Series Expansion 

We would like to have a description of the evolution of the mechanical control system (^ 
when starting from rest. This is accomplished in [^ Q via a series expansion on the config- 
uration manifold Q. 

In the sequel, we let 

m 

Z{q,t)=Y.Ui{m{q). 

i=l 

We have the following 

Theorem 3.3 Let c{t) be the solution of equation (|^ with input given by Z{q,t) and with 
initial conditions c(0) = qo, c(0) = 0. Let the Christoffel symbols r*;,(g) and the vector 
field Z{q,t) be uniformly integrable and bounded analytic in a neighbourhood of q^. Define 
recursively the time varying vector fields 



Vi{(l,t) = / Z{q,s)ds, 
Jo 



where q is mantained fixed at each integral. Then there exists a sufficiently small T^. such 
that the series I^fcli ^fc(Q', ^) converges absolutely and uniformly in t and q, for all t G [0,Tc] 
and for all q in a neighbourhood of q^. Over the same interval, the solution c{t) satisfies 

oo 

c{t) = Y.vMt).t)- (5) 

k=l 

This theorem generalizes various previous results obtained in 0, ^ under the assumption of 
small amplitude forcing. The first few terms of the series (1^) can be computed to obtain 



c(t) = Z(c(t),t)-^(Z:Z)(c(t),t) + i((Z:Z):Z)(c(t),t) 



^ Z:Z):Z): z){c{t),t) - l((z : z) : (z : z) ){c{t),t) + 0(||Zf t^),(6) 



2 ^ 
where Z{q, t) = Jq Z{q, s)ds and so on. 

4 The One-Input Case 



Theorem 3.2 gives us sufficient conditions for small-time local configuration controllability. 



A natural concern both from the theoretical and the practical point of view is to treat to 



sharpen this controUabiUty test. Lewis |12] investigated the single-input case and managed 
to prove the next 

Theorem 4.1 Let {Q,g) be an analytic manifold with an affine connection V. Let Y be an 
analytic vector field on Q and qq G Q. Then the system 

Ve(t)C(t) = u{t)Y{c{t)) 

is locally configuration controllable at Qq E Q if and only if dimQ = 1. 

The fact of being able to completely characterize STLCC in the single-input case (something 
which has not been accomplished yet for general control systems of the form (Q)) suggests 
that understanding local configuration controllability for mechanical systems may be possi- 
ble. More precisely, examining the single-input case, one can deduce that if (@) is STLCC at 
go then dimQ = 1, which implies {¥ : Y) (go) G span{y(go)}, i.e. sufficient conditions for 
STLCC are also necessary. Can this be extrapolated to the multi-input case? The following 
conjecture was posed by Lewis: 

Consider a mechanical control system of the form (Qj which is locally configuration 

accessible at go G Q. Then it is STLCC at go if and only if there exists a basis of input 

vector fields which satisfies the sufficient conditions for STLCC at go. 



Theorem [4.1| implies that the conjecture is true for m = 1. In the following section we prove 



that this conjecture is also valid ioT m = n — 1. 



5 The case m = n — 1 



The following lemma, taken from |^, will be helpful in the proof of the theorem of this 
section. 

Lemma 5.1 Let Q be an analytic manifold. Given qo E Q and Xi, . . . ,Xp G X{Q), p < n, 
linearly independent vector fields, there exists a function cf) : Q — > M satisfying the properties 

(i) (j) is analytic 
(%%) (l)iqo) = 



(in) Xi(0) = . . . = Xp_i(0) = on a neighbourhood V of Qq 
(iv) Xp(0)(go) = -1 
(v) Within any neighbourhood of Qq there exists points q where (j){q) < and (j){q) > 0. 

Proof: Let Zi, . . . , Z„ be vector fields in a neighbourhood of go such that {Zi(go), • • • , ^n(Q'o)} 
form a basis for Tq^Q and Zi = Xi, 1 < i < p — 1, Zp = —Xp. Let tj i — > ^i(^) be the fiow of 
Zi, 1 < i < n. In a sufficiently small neighbourhood V of q^, any point g mat be expressed 
as g = \E'i(ti) o . . . o \l/„(t„)(go) for some unique n-tuple (ti, . . . , t„) G M". Define 0(g) = tp. 
It is a simple exercise to verify that satisfies the required properties. \qed\ 

Next, we prove the main result of this paper. To get an idea of how the proof works, the 
interested reader is referred to f^, where the simpler case m = n — 1 = 2 was treated. The 
proof of the general result is considerable more involved that the one presented there (due 
to the higher number of inputs) and consists of a careful refinement of it. 

Theorem 5.2 Consider a mechanical control system on a n-dimensional configuration man- 
ifold Q of the form (^ with n — 1 inputs, which is locally configuration accessible at qo E Q. 
Then the system is locally configuration controllable at go if and only if there exists a basis 
input vector fields satisfying the sufficient conditions for STLCC at go. 

Proof: There are two possibilities 

. VYi,r2GD, (rl:y2)(go)G^,o• 
• There exist Fi, ¥2^0 such that (Fi : F2) (go) ^ ^go- 
In the first case, there is nothing to prove. In the second one, we distinguish again two 
possibilities 

(i) There exists Yi e D with (Fi : Yi) (go) ^ Dq^. 
(ii) There exist Fi, F2 G -D, linearly independent at go and such that (Fi : F2) (go) ^ Dq^. 

Case (i) can be easily reduced to case (ii): if (Fi : F2) (go) G -D^o, then define a new Y^ 
by Fi + F2 and we are done. So let us treat the second case. We can complete the 



set {Yi{qo),Y2{qo)} to a basis of Dg„, {Fi(go), V'2(go), • • • , ^m(go)}- Then, we have that 
spanjFi (go), 1^2(90), • • • , ^m(go), (^1 : ^2) (go)} = Tg^Q and can write 

(ri:ri)(go) = lc{Y^{qo),...,Y^{qo)) + au{Yi:Y2){qo) 



{Ym ■■ Y„i) (go) = /c(Fi(go), . . . , ^^(go)) + amm {Yi : F2) (go) 
{Y^:Ys){qo) = /c(Fi(go), . . . , F„(go)) + ais (^ : 1^2) (go) 

(Fm_i : Ym) (go) = /c(Fi(go), . . . , ^^(go)) + flm-im (^1 : Y2) (go) , 

where /c(Fi(go), . . . , Ym{qo)) means a hnear combination of yi(go), • • • , ^m.(go)- If an = ... = 
dmm = 0, we have finished. Suppose then that there exists s = si such that Os-^si 7^ 0. To 
prove the theorem, we have to find a change of basis B = (bjk), det (bjk) 7^ 0, providing new 
vector fields in D 

m 

yj=T.bjkYk, l<j<m, 

fc=i 

satisfying the sufficient conditions for STLCC at go. Since 

m m 

^' ■ Y;) (go) = E b,kb,i (n : Yi) (go) = ^ b% (F, : Y^) (go) + 2 ^ b.^b^i (^ : 1^) (go) 

k,l=l k=l l<k<l<m 



m 



lc{Y;{qo), . . . , y^(go)) + I E b%akk + 2 E ^.^^.^aH ) (^ : 1^2) (go) , (7) 

^k=l l<k<l<m 



the matrix B must fulfill 



E b%akk + 2 E bjkbjittki = , 1 < j < m , (8) 

fc=l l<k<l<m 



which is equivalent to 

, _ ~ I^fc^si bjkaksi 
^'' ~ a 



(J2kytsi bjkaksj'^ — O'sisiiY.kjtsi bji^akk + 2 J2k<i,k,i^si ^jkbjidki) 
, l<j<m, 

due to tts^sx 7^ 0. After some computations, the radicand of this expression becomes 

E ^jki'^ksi ~ O-sisi^kk) + 2 E ^'jkbjl{aksi0.lsi — dsisidkl) ■ 
kj^si k<l,k,ly^si 

Denoting by 

all = aksittisi - as^s^aki , /c, / G {1, . . . , m] / {si} , 
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we have that the radicand would vanish if 

Y: &?fc4S + 2 E b.kbjia^^^ = . (9) 

Note the similarity between (H) and (j^). Now, several situations can occur that we study in 
the following. 

Suppose that there exists a S2 such that a^^L t^ ^- Then we can repeat the same steps. 
Define recursively 

r,(^) - n 

^kl — ^kl 5 /.^x 

0^ = «E!aK-«fca-.«ir'\^>2, kje{l,...,m}/{s„...,s,^^}. ^ ' 
Reasoning as before, we obtain that (H) would imply that 

bjs, = Hbji, ...,bjs„..., bjs, ,..., bjm)±^^ E ^jfc^S + 2 E bjkbjiafi^ , 1 < J < m , 

'J^S2S2 y ky^si,S2 k<l,k,l^s\,S2 

where the symbol b means that that the term b has been removed. This procedure can be 
iterated, assuming always that there exists Si such that a^g\. ^ 0. In this way, we finally 
obtain the following equations for the bjs^_^, 



(m-l) I ,/(v7™-lM2" 



^i^™-i = ^i^m ^;^n^ , 1 < J < m . 



Let (6,-, )i<,<„ be a non-zero vector in M™. Now, if (al"'-^) )2 - a^^-^] al™7^) > 0, the 
quadratic polynomial in &js„_i 

ai"-^] bl ,+2a^:^~]l bjs^ ,bjs^ + a^:^-^^, , (11) 

has two real roots and we can choose (&js„_i)i<j<m £ IR™ linearly independent with (&js„)i<j<m 
and such that ([TT|) be positive for all 1 < j < ?n. As this polynomial is the radicand of the 
preceding one, 

E ^k^tk-"^ + 2 E b,,b,,a^--'^ , (12) 

kj^Sl,...,Sm-3 k<l,k,lj^Sl,...,Sm-3 

our choice of (6js^_Ji<j<m ensures that we can again take {bjs^_2)i<j<m ^ IR"^, linearly 
independent with (&js™,_i)i<j<m and (&js„)i<j<m such that (|T^ is positive for all 1 < j < m. 
This is inherited step by step through the iteration process and we are able to choose a 
non-singular matrix (bjk) satisfying (|[). 

If (01"""^^ y - a'{^~^l al"""^^ < 0, then (pll) does not change its sign for all bjs ,, &,s • 
Indeed, we have that sign(|Tl]) = sign(a^™~j^]^_J = sign(a^™'~^^), 1 < j < m. If this sign is 

11 



positive, the former argument ensures us the choice of the desired matrix. If negative, it 
imphes that (|12|) does not change its sign for all bjs^_2, &jsm_i5 ^js™- In particular, notice 
that this ensures us that sign(p!2|) = signfal™"^) J = sign(al™~^^ ) = sign(al'"7^^), for all 
1 < j < m. Then, the unique problem we must face is when, through the iteration process, 
all the radicands are negative. In this case, we can apply Lemma p.l| to the vector fields 
{Yi, . . . , Ym, {Yi : Y2)} to find a function satisfying the properties (i)-(v). By (^, we have 
that 



m -I m m 

i=l ^ j=l k=l 



m -I m 

= T.^^y^ - oE^K^. ■■ Y,)+2Y.uMy3 ■ n) +0(||Z||¥) , 

where Z = YJiLi^iYi. Now, observe that -i-(0(c(t))) = c{t){(l)). Then, using properties (in) 
and (iv) of 0, we get 



d 1 "^ 

jMc{t))) = -Y^a,,u] + 2Y^a,,u,u, + 0{\\Z\\H^). 

j=l j<k 

The expression Z^jLi (^jjuj + 2 J2j<k (ijkUjUk does not change its sign, whatever the func- 
tions Ui{t), . . . ,Um{t) might be, because as a quadratic polynomial in -u^i its radicand is 

always negative. Therefore, ^-(0(c(t))) has constant sign for sufficiently small t, since 
at 

jyjLi^jj^] + '^J2j<kC'jkUjUk = 0{t^) and dominates 0(||Z|pt^). Finally, 

will have constant sign for t small enough. As a consequence, all the points in a neighbour- 
hood of go where has the opposite sign (property (v)) are unreachable in small time, which 
contradicts the hypothesis of controUabihty. 

If (al™~^] Y — a^J^~H a^J^~^^ = 0, we can do the following. For 7 = 1, we choose 61, ^0 
and 

^(m-l) 
h — —h s^^ism _ ry /, 

"lSm_l "ISm (m-1) ^Sm-l'-'lSm 

ClSm-lSm-l 



7 Sm-2Sm-l J-^m-l Sm-2Sm '-^m ^ r 



(m-2) u I fl(m-2) h 

— '^S,n-2^'i-Sm 

(13) 



(m-2) 
ClSm-2Sm-2 



Olsi — — L'siCls 
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We denote Cg^ = 1- For j > 1, we select the {hjk)i<k<m such that the matrix B be non- 
singular. Consequently, we change our original basis {Yi, . . . , 1^} to a new one {F/, . . . , Y^. 
In this basis, following (j^), one has 

(r/:r/)(go) = HYi{q,),...,Yi{q,)) 

{Y^:Y^){qo) = lc{Y;{qo), . . . ,Yi{qo)) + a'^^ {Y, : Y^) (go) , 2<j<m. 

In addition, one can check that 

(r/:y}')(go) = /c(r/(go),...,V'^(go))+(E«H&ife&,7J (n:>^2)(go) 

= /c(y/(go), . . .,Y:^iqo)) + hu^ {y^b^i {y^auiciS\ {Y, : r2)(go) , 2 < j < m. 



Now, computations with Mathematica show that when the Ck are given by ([13|) , then 



and this guarantees us that 

{y; : y;0(?o) = /c(r/(go), • • • , i;;(go)) , 2 < j < m . 

If the a^-j- = 0, 2 < j < m, we are done. Assume then that agg 7^ 0, reordering the input 
vector fields if necessary. Assume further that {Y2 : Y^){qQ) is not a linear combination of 
{Y(, . . . , 1^} (otherwise, redefine a new Kg" ^^ ^2 + ^3)- Then we have, 

{Y^:Y^)iqo) = /c(F/(go), • • • , ll(go)) + a'n (^ : F3') (go) 

(K^ : ^m) (90) = lc{Yl{qo), ..., Y^{qo)) + a^„ {Y^ : Fg) (go) 
(F2' : n') (?o) = lc{Yl{qo),...,Y:,{qo)) + a',,{Y^:Y^){qo) 

(y;_i : r^) (go) = /c(Y-/(go),...,K:(go)) + «:„_!„ (r^Fg') (go), 

where we have denoted with a little abuse of notation by a'-^, the new coefficients correspond- 
ing to {Y2 : Y3'). Consequently, we can now reproduce the preceding discussion, but with 
the m — 1 vector fields {Y2, . . . , Y^}, since Y( does not affect the situation. We look for one 
change of basis B' in the vector fields {1^2? • • • ; Y^} such that the new ones {Y2, . . . , Y^} 
together with Y( verify the sufficient conditions for STLCC. Accordingly, we must consider 
the vanishing of the polynomials 

m 

E b%'<, + 2 E b'^kb-ia'ki = , 2 < j < m . 

fc=2 2<k<l<m 
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The cases in which the last radicand (al™ ^l Y — a^J^ ^l a^J^^ ^^ does not vanish are 
treated as before. When it vanishes, we obtain a new basis {¥(' = Y(, Y2, . . . , Y^} such that 

{Y;' : F/')(9o) , {Y^' : Y^){qo) = /c(r/'(go), • • • , Y^igo)) 
{Y;':Y;'){qo) = lc{Y;'{qo), . . . ,YZ{qo)) + c'^, {Y^ : Y^) (qo) , 3<j<m 
{Yl' : Yf) , {Y^ : Y^'^,) = /c(r/'(go), • • • , Y::,{qo)) , 2<j<m, 

where possibly there exits some 3 < j < m such that c'jj 7^ 0. By an induction procedure, we 
finally come to consider discarding the case of a certain basis {Zi = Y(, Z2 = Y2, . . . , Zm} 
of D satisfying {Zi : Zj)(go) G span{Zi(go), • • • , -^m(i?o)}; 1 < "^ < j < "o^, and the 
sufficient conditions for STLCC at go for Zi, . . . , Zm-i, but such that {Zm '■ Zm){qo) ^ 
span{Zi(go), • • • , ■^m(Q'o)}- Similarly as we have done above, the application of Lemma |5Tl| 
with the vector fields {Zi, . . . , Zm, {Zm '■ Zm)} implies that the system is not controllable at 
go, yielding a contradiction. 

The preceding discussion has been made on the assumption that a series of non-zero elements 
('^i*s )i<i<m-i exists. It remains to consider the possibility when there exists an i > 2 such 
that %l = 0, for all A; G {1, ... , m}/{si, . . . , Sj_i}. This means that the polynomial 

ky^si,...,Si-i k<l,k,lj^si,...,Si^i 

is no longer quadratic, but it has the form 

2 E b,,b,41 . (14) 

k<l,k,l^si,...,Si—i 

If any of the a^*/ is different from zero, then it is clear that we can choose the bjk, k ^ 
{si, . . . , Sj_i}, such that (|14D be positive. Then, reasoning as before, we find a regular 
matrix B yielding the desired change of basis. If this is not the case, i.e. a^*/ = 0, for all k < 
l,k,l ^ {si, . . . , Si-i}, we can do the following. Choose {{bjk)i<j<m}, with k ^ {si, . . . , Sj_i} 
m — i + 1 linearly independent vectors in R"^ such that the minor {bjk}i<j<m-i+i is regular. 
Now, let in (p!3[) that j varies between 1 and m — i + 1, that is, take 



bjsi.i = 


2^kjts-^,...,si^i 'JjkU'Si-ik 


USi_iSi_i 


bjs,_2 = 




Ai-2) 
(lsi-2Si-2 


Ojsi = 


J2k^si bjkO-ksi 



(15) 
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for l<j<m — i + 1. Finally, for j > m — i + 1, we select the bjj^ such that the matrix 
B is non-singular. In this manner, in an unique step, we would change to a new basis 
{YI,---,Y^} verifying 

{Y; : r/)(go) , . . . , (i;;_,+i : K._.+i)(go) = HYliqo), • • • , ^^(go)) 
{Y;:Y;){qo) = /c(F/(go), • • • , ^^(go)) + S,- (Fi : Fa) (go) , m-z + l<j<m 
{Yl:Y/)iqo) = /c(F/(go), . . . , ^^(go)) , k < 1,1 < k < m - z + 1 , 

with possibly some of the (a^j)m-i+i<i<m being different from zero. Now, the above discus- 
sion can be redone in this context to assert the validity of the theorem. 

In short, what we have done is the following: firstly, we have considered the case when for 
all i there exists a Si such that a^^\ ^ 0. We have seen that this case can be subdivided 
into three: one ensuring the desired change of basis, another one which is not possible under 
the hypothesis of small-time local configuration controllability and a third one is a kind of 
"reduced" situation where we can get rid of the problems caused by one vector field. Then, 
under the same assumption on the new coefficients, a'^ (i.e. for all z, there exists a Sj such 
that a'-'-'siSi 7^ 0), we can reproduce the discussion. If we repeteadly fall into the third case, 
we eventually find a contradiction with the controllability assumption. Secondly, we have 
treated the case when this type of "circular" process is broken: that is, there exists an % 
such that (T^. = 0, for all k ^ si, . . . , Sj_i. What we have shown then is that this leads to 
the obtention of either new input vector fields satisfying the sufficient conditions for STLCC 
or a reduced situation where we can get rid at the same time of the problems associated to 
m — i + 1 vector fields. \qed\ 

Remark 5.3 Notice that the proof of this result can be reproduced for the corresponding 
notions of accessibility and controllability at zero velocity. Indeed, a mechanical control 
system of the form (H) with m = n — 1, which is STLC at go and zero velocity is in 
particular STLCC at go. Then, Theorem |5.2| implies that there exists a basis of input vector 



fields y satisfying the sufficient conditions of Theorem p.2| , so the same result is also valid 
for local controllability at zero velocity. 

Remark 5.4 We would like to point out that the differential flatness properties of this 
type of underactuated mechanical control systems have also been studied in intrinsic geo- 
metric terms. Indeed, in W^ it was proved a characterization of conflguration flatness for 



Lagrangian control systems with n degrees of freedom and n — 1 controls and without non- 
holonomic constraints. The importance of flatness to control applications lies in the fact 
that it provides a systematic and simple way to generate trajectories between two given 
states. 
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6 Open problem 



So far, we have not succeeded in generalizing the proof of Theorem |5.2| to the full general 
case, that is, a system with n degrees of freedom and m < n input forces or vector fields. In 
fact, the following simplest case one can consider presents already serious difficulties. Let 
(0) be a mechanical control system on a 4-dimensional configuration manifold with m = 2 
inputs. Assume it is STLCC at go ^ Q- Let Yi, Y2 E D he linearly independent vector 
fields such that span{Yi(go), ^2(q'o)7 (^1 • ^i)(9o)) (^1 '■ ^2)(q'o)} = Tg^Q- Can one discard the 
possibility 

{Y2 : Y2){qo) = aiFi(go) + a^Y^iqo) + a,{Y, : Y2){qo) + a,{Y^ : Y,){qo) , 
with 04 < and Og + Aa^ < 0? 

The conditions on the coefficients 03, a^ prevent us from finding an adequate change of basis 
of Dgg such that the new vector fields satisfy the sufficient conditions for STLCC, or simply 
that make the situation clearer. Moreover, Lemma |5.1| is of no help in this case since when 
applying it to the vector fields {Fi, F2, (^1 : ^2), (^2 : ^2)} we get 

c{tm = (^1^1 + U2Y2 - ^{ul (Fi : Fi) + 2nin2 (^ : Y^) + ul {Y^ : Y^)) + 0{\\Z\\H'>)^ (0) 

= \{nl + a,ul) + 0{\\Zft'), 

where Z = UiYi + ^212. Clearly, ul + a^ul can change its sign. Another possibility is to 
try to sharpen Lemma ^.1| with a view in this case. Without much more difficulty, one can 
modify the proof of the Lemma to ensure, under the assumptions given, the existence of a 
function verifying properties (i), (ii), (v) and 

(in/ Yi{(f)) = ^2(0) = on a neighbourhood V of go 

(zvr (Fi : r2)(0)(go) = ±1, (n : vi)(0)(go) = -1. 

But again this shares the same lot, since we obtain 
1- 



cW(0) = -(Mi=F2MiM2 + Mi(=Fa3 + a4)) 



= -{Ui - M2(±l + Vl - 04 ± 0.3))(Mi - M2(±l - Vl - 04 ± 03)) . 

This expression can change its sign due to a| + 4a4 < ^ |a3| < 1 — 04. 

The following simple example fits perfectly in the above exposed case, except for that we 
do not know if it is small time configuration controllable. If it were so, it would constitute 
a counter example of Lewis' conjecture in its general formulation. 

16 



Example 6.1 Consider a mechanical control system on Q 
The Riemannian metric is given by 



^ with coordinates (x, y, z, w) 



g = dx ® dx + dy ® dy + dz ® dz + dw ® dw , 



and the input vector fields 

Yi - 

Y2 - 
In coordinates, the control equations are given by 



Odd d 

dx dy dz dw 

dy dz dw 



Since 



X = 


{l + z)ui 


y = 


Ml +U2 


z = 


Ui — 2U2 


w = 


{l + y){ui -U2) 


Y, : Fi) 


J d d 

\dx dw 


y-i : Y,) 
Y2 : Y^) 


dx 
dw ' 



(16) 



we deduce that span{Fi(g), F2(q')7 (^i : Y2){q), (Yi '■ Yi){q)} = TgQ for all g G Q and the 
system ([l6| ) is locally configuration accessible. 



In addition, {Y2 : F2) = -(^i : ^2) - (^i : ^i), so 04 = -1 < and al + Aa^ = -3 < and we 
can not conclude that ([T6|) is locally configuration controllable. In this respect, observe that 
whatever projection of the control system ([T6| ) to 3 dimensions we consider, that is, in the 
variables {x, y, z) or (y, z, w), we obtain that the projected system is STLCC. Indeed, we can 
find a change of input vector fields such that the new ones satisfy the sufficient conditions 
(Theorem |5.2| , ra — 1 = 3, rra = 2). 



7 Conclusions 



In this paper, we have been able to demonstrate that the sufficient conditions encountered in 



T5| for a mechanical control system to be STLCC are also necessary when the configuration 
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manifold is n-dimensional and there are n — 1 inputs, in the sense that there exists some 
basis of input vector fields that verifies them. 



In fact, the algorithmic nature of the proof of Theorem ^^ allows us to find such a basis. 
Perhaps it would be useful to determine an ordered procedure that, for a given mechanical 
system, leads us to the obtention of such a basis in a systematic way. This could be very 
interesting in a number of applications, including motion planning, trajectory tracking, 
reliability of autonomous vehicles and the design of mechanisms with fewer actuators than 
typical, yielding less costly devices. 

On the other hand, as we point out in Section 6, the validity of the conjecture in the full 
general case remains still open. 



Acknowledgements 

This work was partially supported by FPU and FPI grants from the Spanish Ministerio de 
Educacion y Cultura and grant DGICYT PB97-1257. We wish to thank F. Cantrijn for 
several useful suggestions and the Department of Mathematical Physics and Astronomy of 
the University of Ghent for its kind hospitality. 



References 

[1] R. Abraham, J.E. Marsden: Foundations of Mechanics. 2nd ed., Benjamin-Cummings, 
Reading (Ma), 1978. 

[2] F. Bullo: A series describing the evolution of mechanical control systems, IFAC World 
Conference, vol. E, Beijing, China, 1999, 479-485. 

[3] F. Bullo: Series expansions for the evolution of mechanical control systems, submitted. 
Avalaible electronically at [http://motion.csl.uiuc.edu/~bullo/papers/ 



[4] F. Bullo: Nonlinear Control of Mechanical Systems: A Riemannian Geometry Ap- 
proach, Ph.D. thesis, California Institute of Technology, 1999. 

[5] F. Bullo, N.E. Leonard, A.D. Lewis: Controllability and motion algorithms for under- 
actuated Lagrangian systems on Lie groups, to appear in IEEE T. Trans. Automat. 
Control, 1997. 



[6] F. Bullo, N.E. Leonard: Motion control for underactuated mechanical systems on Lie 
groups, Proceedings of the 1997 European Control Conference, Brussels, Belgium, 1997, 
480. 

[7] F. Bullo, A.D. Lewis: Configuration controllability of mechanical systems on Lie groups. 
Proceedings of MTNS'96, St. Louis, Missouri, 1996. 

[8] J. Cortes, S. Martinez: Local configuration controllability for a class of underactuated 
mechanical systems, submitted. 

[9] H. Hermes: Control systems which generate decomposable Lie algebras, J. Differential 
Equations, 44 (1982), 166-187. 

[10] S.D. Kelly, R.M. Murray: Geometric Phases and Robotic Locomotion, J. Robotic Sys- 
tems, 12 (6) (1995), 417-431. 

[11] S. Kobayashi, K. Nomizu: Foundations of Differential Geometry. Interscience Tracts in 
Pure and Applied Mathematics, Interscience Publishers, Wiley, New- York, 1963. 

[12] A.D. Lewis: Local configuration controllability for a class of mechanical systems with a 
single input. Proceedings of the 1997 European Control Conference, Brussels, Belgium, 
1997. 

[13] A.D. Lewis: Simple mechanical control systems with constraints, to appear in IEEE 
Trans. Automat. Control, 1997. 

[14] A.D. Lewis: Affine connections and distributions with applications to nonholonomic 
mechanics. Rep. Math. Phys. 42 (1/2) (1998), 135-164. 

[15] A.D. Lewis, R.M. Murray: Configuration controllability of simple mechanical control 
systems, SI AM J. Control Optim., 35 (3) (1997), 766-790. 

[16] A.D. Lewis, R.M. Murray: Configuration controllability of simple mechanical control 
systems, SI AM Rev., 41 (3) (1999), 555-574. 

[17] H. Nijmeijer, A.J. van der Schaft: Nonlinear Dynamical Control Systems, Springer- 
Verlag, New York, 1990. 

[18] J. P. Ostrowski, J.W. Burdick: Controllability Tests for Mechanical Systems with Sym- 
metries and Constraints, J. AppL Math. Comp. Sci., 7 (2) (1997), 101-127. 

[19] M. Rathinam, R.M. Murray: Configuration Flatness for Lagrangian Systems Underac- 
tuated by One Control, SIAM J. Control Optim., 36 (1) (1998), 164-179. 



19 



[20] H.J. Sussmann: Lie brackets and local controllability: a sufficient condition for scalar- 
input systems, SI AM J. Control Optim., 21 (5) (1983), 686-713. 

[21] H.J. Sussmann: A general theorem on local controllability, SIAM J. Control Optim., 
25 (1) (1987), 158-194. 



Jorge Cortes f, Sonia Martinez | 

Laboratory of Dynamical Systems, Mechanics and Control 

Instituto de Matemdticas y Fisica Fundamental, CSIC 

Serrano 123, 28006 Madrid, SPAIN 

\ e-mail: j.cortes@imajf.cfmac.csic.es ^e-mail: s.martinez@imaff.cfmac.csic.es 



20 



